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Abstract 

^: 

Starting from the definition of a stiffness matrix, the authors present a new formula- 
tion of the Cartesian stiffness matrix of parallel mechanisms. The proposed formulation 
is more general than any other stiffness matrix found in the literature since it can take 
into account the stiffness of the passive joints, it can consider additional compliances 
in the joints or in the links and it remains valid for large displacements. Then, the 
validity, the conservative property, the positive definiteness and the relation with other 
formulations of stiffness matrices are discussed theoretically. Finally, a numerical ex- 
ample is given in order to illustrate the correctness of this matrix. 

1 Introduction 

A robotic manipulator is a mechanism designed to displace objects in space or in a plane. 
Therefore, a high precision in the position and orientation of the end-effector and a good 
repeatability of motion are desirable properties of a manipulator. To fulfil this objective, an 
accurate model of the mechanism is required. In particular, it is important to be able to 
precisely characterize the stiffness of the manipulator, i.e., to determine the relation between 
the loads applied to the mechanism and the resulting displacements. The mathematical 
object most commonly used to characterize the stiffness of a mechanism is the stiffness 
matrix. 

In the literature, numerous papers deal with the stiffness matrix (SM) of robotic manipu- 
lators (See section 12]). However, to the best knowledge of the authors, none of them presents 
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a SM that is general and valid for any parallel mechanism (PM), notably, PMs with passive 
joints that have a non zero stiffness and where some additional compliances (in the joints 
as well as in the rigid links) are taken into account. The latter correspond to elastically 
articulated rigid-body systems [1] or compliant mechanisms [2] (notably when the compliant 
joints are modelled using a multi-degree of freedom (DOF) pseudo-rigid body model |3]). 
Since such a matrix is essential for the quasi-static |1] and the dynamic modelling of these 
mechanisms, a SM is presented in this paper that considers the external loads, the changes 
of geometry of the mechanism, the stiffness of actuated and passive joints and even the finite 
stiffness of the rigid links, for both planar and spatial PMs. 

After an overview of the literature on the SM, the kinematic model of a PM that takes 
into account the passive joints is recalled. Then, expressions of the potential energy are 
derived in order to obtain the generalized stiffness matrix (GSM) of a PM and a general and 
meaningful form of its Cartesian stiffness matrix (CSM). The properties of this matrix are 
then discussed and finally, an application using the CSM is presented in order to illustrate 
the correctness and the possible applications of the presented matrix. 



2 The Stiffness Matrix in the Literature 

Definition Usually, a SM is mathematically defined as the Hessian matrix of a potential, 
i.e., the square matrix of second-order partial derivatives of this potential. For example, the 
CSM of a planar mechanism is the Hessian of the potential ^ j associated to a wrench f with 
respect to the Cartesian coordinates. It is written as 

where (ixc represents a infinitesimal variation of the pose. However in many cases, such a 
potential energy cannot be determined and the latter definition cannot be applied. The SM 
is then defined as the Jacobian matrix of a wrench. This is written as 

It can be noticed that, when the associated potential is known, the conservative wrench is 
equal to the gradient of and both definitions are equivalenll^. 

Surprisingly, the SM of a mechanism submitted to an external load is symmetric only 
when it is written in a coordinate basis [514T2]. It is asymmetric otherwise. Chen and Kao 
add in [TSHTT] . that a SM is conservative, i.e., the work done by a force resulting from this 
matrix along a closed path must be equal to zero. Finally, the Hessian matrix of a potential 
being used to determine the stability of an equilibrium [9| [T8] - [20] . a SM can be either positive- 
definite (or semi-definite) in a stable equilibrium or not in an unstable position. 



^In the literature, it is sometimes stated that a wrench is equal to the opposite of the gradient (f = — V^/) 
and that a stiffness is equal to the opposite of the Jacobian matrix of a wrench (K = — Vf ). These definitions 
lead to the same results. 
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Literature review In 1980, Salisbury was the first to formulate a SM for serial mechanisms 
in [21] . Then, the formula was extended to PMs in which only the stiffness of the actuators 
was considered [22ll23]. In fact, both matrices — which are still often accepted and applied 
nowadays — , are only valid in very particular conditions, pointed out by Chen, Kao et al. 
in [TSHTS] : they are correct only when the external loads are zero or when the Jacobian 
matrix of the mechanism is constant. The misconception stems from the improper use of 
the following equations: 

f =Kc(5x 

where f is the vector of the external loads, 5ij) a small displacement of the joints, J the 
Jacobian matrix of the mechanism and 5x a small displacement of the effector in the first 
equation and a small gap of pose in the second equation. When both equations are used 
together, a small gap and a small displacement are incorrectly considered as equivalent and 
the second equation becomes inconsistent: when the external load remains constant, there 
should be no displacement of the mechanism. 

The SM proposed by Chen, Kao et al. in [T3] is correct for both serial and parallel planar 
mechanisms and it has been extended to spatial mechanisms in |T7]. Using screw theory, 
Griffis and Duffy also noted the influence of an external load on the SM . However, the 
proposed matrices still suffer from some lack of generality: they cannot take into account 
the stiffness of the passive joints and the degree of mobility (DOM) of the mechanism has 
to be equal to the DOF of its end-effector platform. This results in a loss of accuracy in the 
modelling of compliant mechanisms. 

In [25l[26], Zhang and Gosselin studied PMs with a constraining leg whose compliances 
were modelled as virtual joints. Thus, the SM that they proposed considers the stiffness of 
some passive joints. However, they did not describe the effects of the external load nor the 
effect of the internal force. Furthermore, their SM is not formulated in a general way and 
can only be applied to the type of PMs with a constraining passive leg. Finally, some works 
have been published that use a SM approaching the one presented in this paper, however 
without mainly focusing on it. For example, [27] considers a redundant actuation and [25] 
considers the stiffness of the passive joints . 

3 Model of a Parallel Mechanism 
3.1 Geometric Constraint 

In a PM, the closure of the loops formed by the legs defines c geometrical constraints that have 
to be satisfied by the joint coordinates. However, since these constraints can be dependent 
in the case of an overconstrained mechanism, the actual number of independent geometric 
constraints is C < c). The constraints are written as 

K,{e) = Oc, (4) 

where is the joint coordinate vector of the mechanism, including all joints, actuated and 
passive. Note that the flexibility of the links and actuators can be taken into account by 
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adding virtual elastic joints in the mechanism [25l|26l|29] . These additional coordinates are 
also included in vector 0. 



3.2 Generalized Coordinates 

A vector of generalized coordinates is defined such that A the vector of the kinematically 
dependent coordinates and 0, the complete joint coordinate vector of the mechanism, always 
satisfy the geometric constraints. One has: 

A = A(V') and = ^(t/^) (5) 

where A = [Ai; ■ ■ ■ ; A^] and 6 = [9i; ■ ■ ■ ; 9m] with m the number of joints in the mechanism 
and 6k the coordinate associated with the k^^ joint. The dimension 97t of vector i/' equals 
the number of DOM of the (kinematically equivalent) mechanism, such that DJl + (t = m. 

Structure of vector 0: The dependent and the generalized coordinates can be chosen 
arbitrarily. They can correspond to joint coordinates or to functions of the latter. If joint 
coordinates are chosen as dependent and generalized coordinates, they can be sorted such 
that can be written as 9^ = [ip"^; X^] . 



3.3 Kinematic Constraints 

The variation of the kinematically dependent joint coordinates is described by a matrix G 
and a matrix R defined as 



G 



dX 



and R 



dO 

d^ 



G 



(6) 



where Igjt stands for the (9H x 971) identity matrix. The above matrices represent the kine- 
matic constraints in a PM. The relations between the variation of the joint coordinates and 
the variation of the generalized coordinates are expressed as 



dX = Gdip and dd = Rdip. 



(7) 



3.4 Kinematic Model 
3.4.1 Pose of the Platform 

The pose of the platform, represented by a set of parameters x, is defined as the average 
pose of the end-effector of all legs of the mechanism. For the i*^ leg, the latter is written 
as xf = [cf; qf ] , Cj being the position vector of a chosen point on the platform and a set 
of parameters representing the orientation. The legs of the PM are indexed from a to n. 

In a planar mechanism, qj is an angle along the z-axis; in a translational spatial mech- 
anism, the orientation is constant thus q^ is not used; and in the general 6-DOF spatial 
case, qj is a quaternion vector describing the orientation of the platform. 
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3.4.2 Variation of the Pose of the Platform 



Lx, where L 



(8) 



The instantaneous Cartesian variation of the pose of the platform is represented by a vector t 
defined as t-^ = [v^;a;"^], v being the velocity of a chosen point of the platform and uj its 
angular velocity. In a planar mechanism, t is equal to the instantaneous variation of the 
pose X, i.e., v = p and a; = q. But in the spatial case, since the angular velocity is a 
3-coordinate vector, a 3 x 4 matrix A is used to determine a; as a function of the variation 
of the quaternion vector q (See [30]). Defining a 6 x 7 matrix L, the variation of the pose 
can be written as 

1 
A 

An infinitesimal Cartesian variation of the pose (ixc can also be defined as 

(ixc = tdt = L(ix, (9) 

where dt represents an infinitesimal period of time. In the planar case, dx^ = but in the 
spatial case, (ixc has 6 components, while dx has 7 components. 

3.4.3 Cartesian Kinematic model 

The Jacobian matrix of a PM in which all joints — even the passive ones — are considered 
is defined in [3] as the Jacobian matrix of the Cartesian pose with respect to the joint 
coordinates. It is written as 

J« - (10) 

This matrix is actually composed of the columns of matrices J^^ to Jg„ , the Jacobian matrices 
of each of the legs considered as an independent serial mechanism. 

The Jacobian matrix of the pose of the end-effector with respect to the generalized 
coordinates is noted J and is defined as 

The Cartesian kinematic model of the mechanism is written as 

t = Jg6> = JgR^p = J^p. (12) 

3.4.4 Complete Kinematic Model 

In a mechanism, especially in a compliant one, the number of DOM OJl can be larger than 
the number of degrees of freedom ^ of the end-effector platform [3l[29], thus determining 
only t may not be sufficient to completely determine the configuration of the mechanism. 
Therefore, t comprising components, (DJl — ^) additional output coordinates are chosen 
to complete the kinematic model. They are noted and assembled in a vector y. These 
coordinates can be any Cartesian coordinates of others points of the mechanism as well 
as joint coordinates. By assembling all the i/i and the ^ components of t in a vector u 
containing 9Jl components, the direct complete kinematic model can be written as 



u 



t 




J 


y. 




Jy 



^ = HV', (13) 
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where H is the WlxTl complete Jacobian matrix of the mechanism and Jy is the (9Jt— 5") x 971 
Jacobian matrix of the yi coordinates with respect to the generahzed coordinates. 



Inverse Kinematic Model In a non singular configuration, H is invertible. Then, from 
equation f lT3|) . the inverse kinematic model of the mechanism is expressed as : 

= n^u. (14) 

When OJl = 5; no additional coordinates are required, thus u = t and H = J. In this 
case, equation (JH]), can be written as 

= J"H. (15) 



Infinitesimal Variation With the infinitesimal variation of the pose and of the yi coor- 
dinates, the complete direct and inverse kinematic model are respectively written as 



dy 



Hdip and dip = H" 



dy 



(16) 



4 Stiffness Matrix of a Parallel Mechanism 

4.1 Potential Energy of a Mechanism 
4.1.1 Elastic Potential Energy 

The potential energy stored in the elastic joints of a mechanism, noted C,9, is written as 

^e= f T],de= r TldiP+ [\ldX (17) 

where Tj is the vector of joint torques/forces associated with the joints corresponding to 
vector j and where O^, t/'o and Aq correspond to the undeformed configurations of the joints. 
In the particular — but frequent — case of elastic joints with constant stiffness, the potential 
energy is written as 

6 = ^AiP^K^Ail^ + IaA^KaAA, (18) 
with Alp = ip — ipQ and AA = A — Aq and where and K;^ are the (diagonal) joint SMs. 



4.1.2 Conservative External Load 

In a planar mechanism, the potential energy associated to the load f applied to the 
end-effector platform is equal to 

0= rf^rfx,= Tf^jrfV', (19) 

where xq corresponds to the unloaded configuration. 
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In the spatial case since the angular velocity w and the infinitesimal variation of pose (ixc 
are not integrable, the associated potential cannot be written. However, the instantaneous 
power of a 6- dimensional external load is defined as 

= f^'^v + m^w = Ft = FJtA, (20) 

where = [f;^; m^] , f; representing the 3-dimensional force vector and m the 3-dimensional 
moment vector. 



4.1.3 Potential Energy of the Mechanism 

In a planar mechanism, the potential energy C,f due to the external wrench is equal — apart 
from a constant — to the energy stored in the mechanism (^/ = ^e + ^o)- Using eq.(I7]) and 
eq. (fT9|l . this can be written as 

r f^JdV' = r rldxl^ + r rlGd^l^ + Co, (21) 

"^'/'/o -^^/o -^"^fo 

where represents the energy stored in the mechanism in configuration -j/j^q, where f = 0. 
This energy is not zero when a preload exists in the compliant joints. The infinitesimal 
variation of eq. (!2T]) is also valid for a spatial mechanism. It is written as 

f^JrfV = Tldil) + rlGdi/^. (22) 



4.2 Static Equilibrium 



Differentiating eq. fl2T|) with respect to the generalized coordinates t/) leads to the generalized 
static equilibrium of a mechanism subjected to an external wrench, which is written as 

di^-d^^d^^^ f-T^ + G r.. (23) 

The right-hand side of the latter relation is also valid in the spatial case, since it corresponds 
to the differentiation of eq.( l22l) with respect to di/^. Introducing the generalized force tm, 
eq. (l23|l is equivalent to 

Tm = t^ + G^ta - J^f = 0. (24) 

Note that in the most general case, the stiffness of the joints is not constant and the corre- 
sponding forces/torques are defined as 



/■tp r>- 
= j K.^,dil> and tx = Ka^A. (25) 
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4.3 Generalized Stiffness Matrix 



The GSM Km of a mechanism is defined as the Hessian matrix of the potential energy with 
respect to the generahzed coordinates. However when no expression for the potential energy 
is known — such as in the case of a spatial mechanism — the equivalent following definition 
is used: K.m is equal to the differentiation of the generalized force tm with respect to '?/'• 
Therefore, using eqs. and (125|) . it is obvious that K^- is not constant and depends on 
the stiffness of the joints and the geometric configuration of the mechanism. 



dr 



M 



d 



di/j dip 



■^0 



"'■00 



(26) 



which leads to 



where 



dT 



M 



dll) 



d 



(27) 



(28) 



Detailed expressions are derived for K/ and in the next subsections. 



4.3.1 Matrix Kg 

The impact of the external wrench on the configuration of the mechanism is governed by the 
equation t/ = J"^f, where t/ is the vector of joint force/torque due to the external wrench f. 
In this paper, the external load f is assumed to be independent from the configuration, 
thus df/di/) = 0. Matrix K^; is equal to 

The derivative of the Jacobian matrix dJ'^/dil^ is a tensor of order 3. Although it is not 
a commonly used mathematical object, its manipulation presents no particular difficulty 
(See [13]). In practice, one can differentiate J^i considering f as a constant wrench. This 
matrix captures the effect of a change of geometry on t/ and therefore on tm- Matrix K^; 
is written as 

' -f);---;(^f) 



K, 



, , (30) 

dipi dipfffi J 

where ipi is the i^^ joint coordinate of i/) and {dJ'^ / dtpi)f is a vector forming the i^^ column 
of Wl X Tl matrix K^. It can be noted that matrix K^; is indeed equal to the opposite of 
the matrix noted K^, the active SM introduced in 
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4.3.2 Matrix Kj 

Developing eq.( l28|) . matrix K/ is composed of two elements: 



■TA + G^KaG. 



dip 



(31) 



Similarly to matrix K^;, matrix K/ contains a tensor of order 3, namely [dG'^ / dtp) . There- 
fore, a matrix K/g that captures the effect of the change of geometry of the kinematic 
constraints, is defined as 



K 



IG 



dG^ 
dtp 



-Tx 



JG^ 

' di)i 



AG'' 



-rx 



(32) 



where [dG'^ / dipijr x is a vector forming the i^^ column of 97t x 971 matrix K/g- Recalling the 
definition of matrix G (eq.(l6])), matrix K/g can also be defined as K/g = {d'^^ /dilP')Tx- 
Matrices K/g and G'^KaG are functions of the generalized coordinates and represent the 
contribution of the kinematically constrained joints to the stiffness of the mechanism. This 
contribution is assembled in matrix K/. 



4.3.3 Generalized Stiffness Matrix 

Finally, combining eq. fl27|) . eq.f l29|) and eq.f l3T|) . the stiffness of the mechanisms is described 
in the domain of the generalized coordinates, by matrix K^/ which is written as 

Km = + K, + Kg. (33) 

This matrix includes the three contributions that determine the stiffness of a mechanism, 
namely: the stiffness of the kinematically unconstrained joints (K^), the stiffness due to 
the dependent coordinates (passive joints and additional compliances) and the internal 
torques/forces (K/), and the stiffness due to the external loads (K^;). Note that gravity 
can also easily be taken into account as additional external forces applied at different point 
of the mechanism. 



4.4 Cartesian Stiffness Matrix 

The definition of the CSM as rff^/ (ixc or — df / dxc is valid for planar and spatial mechanisms. 
Using the chain rule, the following derivation can be performed: 

where dyic/dip is the 5^ x 971 Jacobian matrix J defined in eq. fllll) : matrix dip/dTM exists 
since it is the DJl x DJl generalized compliance matrix and it is equal to the inverse of Kjvf 
defined in eq. (!33|) : finally using eq.( p^ . dTM/di is a. Wl x ^ matrix equal to — J^. Thus, 
the CSM is a 5^ X ^ matrix equal to 

Kc= (J(K^ + K, + K^,)-^J^)"\ (35) 
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When DJt = ^ and when J is not singular, the relationship between the stiffness in 
the generalized domain and in the Cartesian domain can be written under a familiar form, 
namely 

Kc = J-^KmJ-^ (36) 
And the inverse relation is written as 

Km = J^KcJ. (37) 

Complete Stiffness Matrix Using the complete kinematic model (eq. (JT3ll and eq. IlT^ ). 
the complete SM — a DJt x Wl matrix noted K.u — can be written as 

Ku = H-^Ka/H-\ (38) 



5 Properties of the Matrix 

5.1 Symmetry 

The properties of the SM for mechanisms without stiff passive joints nor additional com- 
pliance has been intensively discussed in the literature [6|[7tl9l4T2 | [T7 t [20 | [3T]. This matrix, 
noted K^, is written as 

K0; = J-^(K^ + Ks) J-i. (39) 

In matrix K^, matrix is symmetric by definition and matrix K^; is symmetric only when 
it is expressed in a coordinate basis, i.e., a basis satisfying Schwarz's theorem. For example in 
a 2-DOF planar mechanism, matrix K^; is symmetric when the Cartesian coordinates {x,y) 
are used and non-symmetric when the polar coordinates (r, are used In a spatial mech- 
anism, since no coordinate basis can be used to describe a 6-DOF mechanism, matrix K^; is 
not symmetric. Moreover, even if the CSM can be asymmetric, it is conservative [TBHTTj. 

The GSM Ka/ comprises one additional term when the passive joints or the links are 
compliant, namely K/. Since this SM K/ has been calculated as the Hessian matrix of .^a, 
the elastic potential energy stored in joints A with respect to the generalized coordinates i/' 
that form a coordinate basis, K/ is symmetric and conservative. Thus, Kjv/, which corre- 
sponds to the sum of K^, K^; and K/ has the same symmetric and conservative properties 
as Hence, the fact that J is square or not (when additional compliances are added in 
the mechanism) has no influence on the symmetry and the conservativeness of K^. There- 
fore, matrix K^; defined in eq. (l35|l has the same symmetric and conservative properties as 
matrix K^. 

5.2 Positive Definite Property 

In |13], the authors show that the SM of a mechanism without compliant passive joints 
can be positive definite, positive semi-definite or non-positive definite depending on the 
configuration and the external forces. Similarly, the SM presented in this paper can be 
positive definite, positive semi-definite or non-positive definite. Indeed, a SM is by definition, 
a measure of the stability of an equilibrium and a positive definite matrix is required to 
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Figure 1: 2-DOF parallel mechanism in an unstable static equilibrium. 

maintain stability. For example, one can compute the SM of the 2-DOF mechanism shown in 
Fig{Tl When both springs are in tension (p^ > p^o and ph > Pb^), the mechanism is in a stable 
static equilibrium and the SM is positive-definite. When the springs are in compression, the 
mechanism is in an unstable static equilibrium and the SM is non-positive definite since the 
eigenvalue of the matrix corresponding to the vertical axis is negative. Moreover, it can 
be noticed that by choosing 9a and pa as generalized coordinates, the configuration of the 
mechanism shown in Fig{T]is not kinematically singular (i.e., det J 7^ with -0 = [9a, Pa])- 

Any other proposed GSM that does not take into account neither the stiffness of the 
passive joints nor the effects of the changes of geometry (through matrices K/ and K^;) will 
not allow the description of this phenomenon of instability. 

5.3 Other Stiffness Matrices 

The CSMs found in the literature can be easily obtained from the matrix presented here, 
since the latter is more general: 

• In the literature, the DOM Wl is almost always equal to ^ the degree of freedom 
of the end-effector platform, thus exists when the mechanism is not in a singular 
configuration. Therefore, the comparisons in this subsection can be made with eq. fl5^ . 

• The matrices for serial mechanisms (Salisbury [21], Chen and Kao [13]) in which there 
are no passive joints, i.e., 6 = Thus there are no internal wrenches and K/ = 0. 

• The matrices when the external wrench f is zero or the Jacobian matrix is constant 
(Salisbury [21]). Both cases give = 0. 

• The ^Hnfinite" SM of conventional mechanisms that are considered as not sensitive to 
external wrenches. In these cases, the stiffness of the actuators is considered infinite and 
that of the passive joints equal to 0, therefore eq.( l33i) gives Ka/ = diag(oo) and eq.( l35i) 
gives Kc = 003X3- 

5.4 Use of a Stiffness Matrix 

In the literature on the theory of mechanisms, the research papers mainly focus on the ^ 
GSM. However, this matrix is not the most useful SM to describe the behaviour of a PM. 

First, the GSM K.m is simpler to obtain and allows a complete description of the mech- 
anism, notably when DJl > ^, and of the relation between wrenches and displacements — so 
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can the 2)t x 2Jt CSM K.u but the latter is more expensive to compute. Note that the concept 
of GSM is recent, because before the understanding of the influence of external wrenches on 
the stiffness in the 1990's, Km could not be distinguished from K^. 

Then, more important than the changes of coordinate basis that, in fine, correspond to 
the choice between Cartesian or GSM, the idea of characterizing a mechanism by a stiffness 
matrix is not very relevant. Actually, this choice seems to be due to a mimetism with springs 
that are generally characterized by their stiffness. In practice, the computation of the SM 
is not as useful as that of the compliance matrix that determines the displacement of the 
mechanism due to a variation of the wrenches applied on it. For example, the computation of 
the quasi-static model of a compliant PM |^ requires the determination of the generalized 



compliance matrix, 

are written as 



noted Cm and equal to K,^ . The relations between these matrices 



HCmH 



Cc 



3y Jy 



(40) 



where = JCa/J"^ 
compliance matrix. 



is the d>^d Cartesian compliance matrix and Cu, the 9Jtx 9Jt Cartesian 



5.5 Alternative Formulation 

Following the definition of matrices and K/g, the calculation of the GSM Ka/ (eq. fl551) ) 
requires the differentiation of matrices J and G with respect to the generalized coordinates i/?. 
Yet, in practice an analytical expression of these matrices as functions of ip is not always 
known and thus, their differentiation might not be performed simply. For this reason, another 
formulation of Ka/ has been developed that only requires differentiation with respect to 6. 
This alternative formulation is detailed in appendix [B] and is used in the application. 



6 Application to a Compliant 3-RPR Mechanism 

In this section, the stiffness of a compliant 3-RPR mechanism presented in [18] is studied. 
This example is relatively simple and the compliant joints are modelled as 1-DOF joints in 
order to obtain short and simple formal equations. First, the details of the modelling are 
given, then a comparison between the different SMs proposed in the literature is performed 
and finally one new possibility offered by the presented SM is used to show the impact of 
the stiffness of the passive joints on the behaviour of this mechanism. 

6.1 Modelling of the Mechanism 
6.1.1 Geometry of the Mechanism 

Geometric Parameters of the Legs Each leg i, indexed from a to c, is defined by the 
following parameters: 

• All elastic joints are modelled as 1-DOF joints, thus the DOM of the mechanism is equal 
to the degree of freedom of the platform: Tl = ^ = 3. 

• The angles associated with the first revolute joints of each leg are noted a^. Their unloaded 
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Figure 2: 3- RPR planar compliant mechanism. 



configurations arc: = 0.5404 rad, aho = 2.0695 rad and «co = — 1.8252 rad. 

• The coordinates of the prismatic joints are noted pi. Their unloaded configurations 
are pao — 583.10 mm, p^o — 683.22 mm and pco = 688.18 mm. 

• The angles associated with the second revolute joints of each leg are noted Their un- 
loaded configurations are: = 1.0304 rad, Pbo = —4.6875 rad and /3co = 1.3016 rad. 

• The position of the points of the base are Aa = {xao, Uao) = (—50, —50) cm, = (xbo, yw) 
— (50, —50) cm and A^. = {xco, yco) = (—50, 76) cm. 

• The distance between all second revolute joints and the effector's point of reference: la — 
h — h — I- 



Pose of the Platform The pose of the platform, when considered the end-effector of 
the i^^ leg, is written as 





Xi 




Xio + Picai + lic{ai + /3j) 


Xi = 


yi 




yio + PiSOii + lis{ai + /3i) 




4>i 




Oii + A 



where c stands for cos and s for sin. The pose is defined such that Xq = when the external 
forces/torques are f = 0. 



Geometric Constraints on the Platform The platform of this PM is a rigid body. 
Hence, the distance between each of the attachment points of the legs on the platform must 
remain constant. The position of the attachment point of leg i is noted Cj and is written as 

Cj = [xio + piCai] yig + pisaif . (42) 



The distance CiCj between 2 points Cj and Cj can be calculated with the following equation, 

I (43) 

= Y (^cj - xcif + {ycj - yciY = Lij 

where Lij is the constant distance between Cj and Cj. These constraint equations can then 
be written as 

g,, = QC]' - 4, tj e {a, 6, c}\t^ J. (44) 



13 



Geometric Constraints and Generalized Coordinates Since there are two indepen- 
dent kinematic loops in tliis planar mechanism, 6 constraints have to be satisfied. This 
mechanism has 9 joints and thus its number of DOM is 3. 

The 3 coordinates pi are arbitrarily chosen as the generalized coordinates. Thus, the 
vector of generalized coordinates is written as %j) = [pa] Pb] Pc\^ and the vector of all the joint 
coordinates in the mechanism is written as 











A 





1 

[pa] Pb\ Pc] 

[ua] 13a] oib] /3b; ac, (3c 



(45) 



where A = [aa] (3a', otb] (3b-, otc] /Sj'^ is the vector of the dependent joint coordinates. 

The rigidity of the platform must always be satisfied, i.e., the position of the end 

of the 3 legs must be equaj^ and the distance between the attachment points must always 
remain constant. Thus, the constraint function for a kinematic loop is written as : 



Vi - Vj 

Qij 



0. 



(46) 



And the vector of the kinematic constraints for the whole mechanism is defined as 

K(e) 



K,ab{e) 



(47) 



6.1.2 Kinematics: Infinitesimal Variations 



Rigidity of the Platform The differentiation of the square of the distance between the 
attachment points on the platform with respect to the joint coordinates is calculated as 



= -2cai{xjo + pjcaj - - piCOi) 
+2sai{yjo + PjSaj - yio - PiSai), 
dQ^i _ 2pisai{xjo + Pjcaj - x^ - picai) 
-2picai{yjo + pjsaj - yio - PiSai), 



dai 

dQij 
. d(3i 



(48) 



0. 



Kinematic Constraints Matrix S is defined in app endix I A . 1 1 and represents the infinitesi- 
mal kinematic constraints such that SdO = 0,\/d6. It is equal to dK/d6. Matrices and Sa 
are constructed using the corresponding columns of matrix S, namely 



Sa — [Sa^; S/3j; . . . ; Sp,^] and S^ — [Sp^; Sp^] S 



P3i 



(49) 



^The third component of the pose, representing the orientation of the platform is not used because this 
orientation is not a function of xp, the generahzed coordinates. 
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6.1.3 Stiffness Matrix 

The formulation presented in equation ( l68l) witli tlie details given in appendix [B] is used in 
this application, namely 

Kc = J-^ [R^iKe + K^)R + K^] J K (50) 

Matrices G, R, J a and J Since all components of matrices and Sa are explicitly 
known, a formal expression of matrix G could theoretically be obtained. However, the 
inversion of the 6x6 matrix will lead to a very complex expression, and it is therefore 
simpler to compute G numerically, i.e., compute and Sa from their formal expression 
and then compute the inversion and multiplication as given in appendix IA.2I 

Matrix Ja corresponds to the last 6 columns of matrix 3g and matrix J is obtained by 
right-multiplying matrix Jg by matrix R (eq. lfTTi) ). 

Matrix By definition (eq JMl) . matrix Kg requires taking the derivative of 3$. This 

differentiation can be preferably performed formally in order to avoid round-off errors due 
to a numerical derivation. Moreover, to avoid manipulating a tensor of 3'^'^ order, matrix 
is calculated as 

= Jacobian(jJf , d) (51) 
where f = [fx]fy', ra^j] is considered constant. 

Matrix This matrix is more complicated to compute, because obtaining a formal 

expression of R is almost impossible for the 3-RPR mechanism. Therefore, the alternative 
formulation of K/j detailed in appendix [B] is used. The algorithm used to implement and 
compute matrix K/j without introducing numerical errors, is presented below. 

• Calculate formal expressions of matrices Sa and S^. 

• Calculate a formal expression of matrices Mp and Ma, with the constant vector (v = 

M.p = Jacobian(Sjv, d), ^^^^ 
Ma = Jacobian(Sjv, 6). 

• Compute numerically vectors Sa and v : 

Sa = Ka(A - Ao) - Jif and v = S^^sa. (53) 

• Assign the numerical value of the components of v to variables Vi to enable the com- 
putation of Ma and Mp. 

• Compute numerically R (appendix IA.2p . 

• Finally compute K.r : 

Kr = (-Mp + S/S^^Ma)R. (54) 
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Stiffness Matrix With the above matrices and vectors, the CSM of the 3-RPR mecha- 
nism can be computed in any non-singular configuration, using the formulation presented in 
eq.(l68]). 

6.2 Simulation of the Mechanism 

In order to illustrate the validity and the accuracy of the proposed SM, a simple application 
is presented below. 

The trajectory followed by the 3-RPR mechanism subjected to an external wrench (ap- 
plied on its end-effector) is computed using the SM. Actually, each increment of the external 
wrench multiplied by the SM computed in the local configuration provides an incremental 
displacement and the combination of all these displacements enables to plot the trajectory. 
In other words, the trajectory is computed with the following expression, implemented nu- 
merically: 

x^x + K^^5f. (55) 

On the other hand, the results of the commercial software MSG. Adams are used as references 
to evaluate the accuracy of the computations and indirectly to prove the validity of the 
presented SM. In MSG. Adams, the equilibrium and the position of the mechanism are 
computed at each step and therefore there is no drift due to an iterative method. Moreover, 
by choosing the static simulation option, the dynamical effects are not taken into account, 
which is consistent with our assumptions. The wrench applied on the reference point of the 
platform is 

m = [/osin(27rt);/osin(47rt);0]^, /o = lOOiV. (56) 
6.2.1 Comparison with Other Formulations 

In this subsection, we consider a mechanism in which the stiffness of the actuators are finite 
but the stiffness of the passive joints is equal to zero. 

With this simulation, we can compare (a) the accuracy of the SM presented by Salis- 
bury [2T], (6) the accuracy of the SM presented by Ghen and Kao [I3] and (c) the accuracy 
of the proposed SM. The SM for PMs presented in this paper is noted PM (c). Matrices (c) 
and (6) represents the conservative congruence transformation (GGT). 

To make the comparison between all these matrices, matrix (c) is computed with the 
value of stiffness of the passive joints equal to zero (K^ = 0). Thus, formulations (6) 
and (c) become equivalent, but since their implementation are different, mainly because 
of the alternative formulation used here, their computation can provide slightly different 
results. The three expressions of Kc are written as 

(a) Salisbury : Kc = J~^Kp3~^ 

(6) Ghen : Kc = Jf {K, + K^) 3;' (57) 
(c) PM : Kc = J-^ (K^ + K, + K^) J'^ 

where 3p is the Jacobian matrix usually used for the 3-RPR mechanism, Kp is the 3x3 
diagonal matrix representing the stiffness of the actuators pi and K^ corresponds to the 
matrix (— Kc) defined in [13]. In cases (a) and (c), the coordinates of the passive joints 
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Figure 3: Trajectory {x,y) described by the mechanism subjected to f(t). 
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Figure 4: Discrepancy in x-coordinate of the pose of the mechanism subjected to f(t). 

and j3i do not appear. The time of simulation t varies from s to 1 s in 250 iterations, such 
that St = 1/250 s (4ms). The increment of external wrench is 5f = {'{t)6t. And the stiffness 
values of the joints used in this section are = = ON.rad~l and kp = 2000N.mm~l. 

Results Figure E] shows the trajectory described by the mechanism, computed with the 
software MSG. Adams and with the four matrices. It can be noticed that the results obtained 
with matrix (a) does not correspond to the trajectory computed with MSG. Adams, while 
results of the GGT matrices (6) and (c) are accurate. Since the results are very close to each 
other, they are presented in another form in Figs. HI |5] and [61 The latter graphs show the 
difference in the 3 components {x,y,(f)) of the pose x, between the reference from MSG. Adams 
and the computation with each matrix. 

Some important points can be noted on the graphs: 

• The discrepancy between the results obtained with MSG. Adams and with the GGT matri- 
ces increases uniformly as the simulation proceeds. This effect is a drift due to the iterative 
computation. In a real use of these matrices, the variables are updated by a measurement 
on the robot at each step, thus this drift should disappear. 

• On the contrary, the discrepancy between the results obtained with MSG. Adams and 
Salisbury's matrix is clearly a function of the external loads. The larger these loads are, the 
larger the error in the stiffness computation will be. The drift due to the iterative computa- 
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Figure 5: Discrepancy in y-coordinate of the pose of the mechanism subjected to f(t). 
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Figure 6: Discrepancy in 0-coordinate of the pose of the mechanism subjected to f(t). 

tion also exists but it is secondary compared to the effect of loads. We can however observe 
that the error due to the load seems to be compensated for since the error decreases when 
the load decreases. 

• As shown in Fig. [31 the simulation with the CCT matrices are much more accurate than 
with Salisbury's matrix. The range of deviation for the CCT matrices after 250 iterations 
is 0,5/im in position and 2.10"^ rad in orientation, while the maximal deviation for Salis- 
bury's matrix is 3 fim in position and 1, 2.10"^ rad in orientation. 

• A small difference between matrices (6) and (c) can be noticed at the end of the simulation 
(notably in Fig. |5] and Fig. [6]). These differences are only due to the numerical computations. 

Conclusion This simulation confirms the validity and the equivalence of both CCT for- 
mulations. It also shows their accuracy. On the other hand, this simulation proves the 
invalidity of Salisbury's matrix. Indeed, if the latter matrix can seem acceptable for very 
small external wrenches such as vibrations, the error grows quickly with the loads. 

6.2.2 Impact of the Passive Joints 

The main novelty of the SM proposed in this paper is the possibility to take into account the 
stiffness of the passive joints. Figure [7]illustrates this new possibility and shows the trajectory 
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Figure 7: Trajectory {x,y) described by different mechanisms subjected to f(t). 

performed by the mechanism when it is subjected to the external wrench f(t) defined in 
eq. fl56|) . This trajectory is computed with passive joints having different stiffness k^^ and kj^., 
namely: ON.rad"^, lON.rad"^ and lOON.rad"^. Note that the trajectories calculated with 
MSG. Adams are not represented in figure [7] because they coincide exactly with those of our 
model. The discrepancy cannot be observed at this scale. 

As expected, it can be observed that stiffer passive joints give a stiffer mechanism and 
decrease the amplitude of the displacement due to external wrenches. The shape of the 
displacement is also affected. The curve drawn with crosses represents the trajectory of a 
mechanism in which the stiffness of the passive joint is only 20 times smaller than that of the 
actuators, but even in this extreme and almost unrealistic case, the trajectory is computed 
with a very good accuracy. 

The important point illustrated by this application is the possibility to accurately deter- 
mine the behaviour of a mechanism subjected to external loads. Indeed, the stiffness of the 
passive joints can be regarded as an advantage or as a disadvantage in the context of control 
of a manipulator since it makes the manipulator less sensitive to external perturbations but 
requires more powerful actuators. However, if high precision is required, with the new SM 
that enables to compute accurately their behaviour, compliant joints with zero mechanical 
clearance offer only advantages. In other words, with the knowledge of the SM, the precision 
of a mechanism becomes independent from its stiffness. 

7 Conclusion 

The proposed formulation of the stiffness matrix is clear and meaningful. The presented 
Cartesian stiffness matrix is a generalization of the already existing matrices published in 
the literature, since it can take into account non-zero external loads, non-constant Jacobian 
matrices, stiff passive joints and additional compliances, these two latter points being its 
main novelty. 

Moreover, the results predicted with this stiffness matrix are very accurate and the pro- 
posed SM enables a very accurate control of parallel manipulators built with elastic joints. 
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A Matrices of Constraints 
A.l Matrices S, Sa and 

From the geometric constraints (eq.(|l])), the kinematic constraints of a PM can also be 
written as 

dK.{0) = '^^^^dO = SdO = 0, (58) 
dO 

where matrix is S is defined as the derivative of JC with respect to 0. Making the distinction 
between the generalized and the dependent coordinates, one can write 

= S.^,dip + SxdX = 0, (59) 

where is the (txDJl matrix composed of the Tl columns of S corresponding to i/y and Sa 
is the € X (E matrix composed of the € columns of S corresponding to A. 

A. 2 Matrices G and R 

By definition, the € coordinates Aj are the solutions of the C geometrical constraints K 
for a set so Sa = dJC/dX is a matrix of full rank and therefore is always invertible. 
Equation fl59]) is equivalent to 

dX = -S^^S^dilj. (60) 
Thus, matrices G and R are expressed as 

G = — S^^S^ and R = 



SdO — [S^; S> 



dX 



J- an 



(61) 



22 



B Implementation of the Stiffness Matrix 



B.l Alternative Formulation of K 



c 



B.l.l Matrix Ke 

In some PMs, a formal expression of J as a function of ip can be difficult to obtain whereas 3g 
is easy to formulate as a function of coordinates 6i. And G and R are defined as function 
of 6. Therefore, it is generally more interesting to calculate d{-)/dO instead of d{-)/dip. 
Using equation (fTTl) . the definition of K^; (eq. (j29l) ) is equivalent to 



K, 



dtl^ 



T 



, djg 



rf(JeR; 

^ dO c/R"^ rp 



(62) 



In this equation, matrix {—dJe/d6)^f is noted K^. In this matrix, the kinematic constraints 
are not taken into account, each leg is considered as an independent mechanism. Hence, 
since R"^ = [l; G^^] , the last term of eq. fl62|) is noted K^eg and can be calculated as 



K 



EG 



dK' 



dG' 
R. 



(63) 



where J a = dyic/dX contains the columns of 3g corresponding to coordinates Aj. Thus eq. fl62l) 
can be written as 



K, 



R^K^pR + K 



EG- 



(64) 



B.1.2 Matrix K/ 

A matrix K/j that represents the effects of the change of the constraints G^ is defined by 

Kn = KjG + Keg = ^ T,-^ Jlf. (65) 



Thus, with the same operations as in section fIB.l.ip . is calculated as 



R 



dG- 



R. 



(66) 



where represents the sum of the forces/torques applied on the constrained joints. 



B.1.3 Cartesian Stiffness Matrix 

Using the above matrices, Kc can be written as 

Kc = 3^ (K^ + G^KaG + + R'^K^R) 3 \ 
This latter equation being equivalent to 

Kc = J-^ [R^(K, + K^)R + Kh] J-^ 



(67) 
(68) 



23 



B.2 Computation of Matrix K^^ 

Matrix results from the differentiation of matrix G. But since a formal expression of G 
might be too complex to be handled in closed form due to the inversion of the x C) 
matrix S\, an alternative method to calculate it can be used. Moreover, the derivative of a 
matrix with respect to a vector gives a tensor of 3^'^ order, and this type of mathematical 
object and all its associated functions are usually not developed in most current software 
packages. For the above reasons, a detailed formulation of is presented below. This 
formulation is easier to implement and it enables the computation of Ki^ without introducing 
numerical inaccuracies. 

To avoid taking the derivative of matrix S with respect to vector 6 — which gives a tensor 
of 3'''^ order — the vector G-^s^ is first calculated 

G^SA = -S^^SJsa. (69) 

Then, the Jacobian matrix of G"^sa with respect to 6 can be calculated, considering sx as a 
constant vector (noted s\) 

dG^ rf(G^sl) d(-S|0_ 
Equation (170|) is equivalent to : 



«A = --7#S,-^sI-Sj-A-sI. (71) 



Since calculating a formal expression of S^^ might be too complex and since a formal deriva- 
tive is desired to avoid any round-off errors in the computation of Kg, the following equivalent 
formulation of S^"^ is used. In this equation, the inversion can be computed numerically but 
the derivative can be obtained formally. 

Thus, equation ( ffTI) is equivalent to 



S,-^sI+SjS/-^S,-^sI. (73) 



Here again, the derivative of a matrix with respect to a vector is required. To avoid such a 
derivative, the following vectors are introduced : 



(74) 



For practical purposes, the vectors and mA are formally calculated with a vector of 
constant components {y_ = [vi, ■ ■ ■ ,Vtt] ), then the formal derivatives are calculated. Finally, 



V 


= Sa^sa 






= S^S;^ Sa 


= Sjv 


niA 


= SlS^^^SA 
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the numerically computed components of v are assigned to variables Vi to obtain matrices 
and Ma. 

dSji. rr dm 



de ^ dO ^75) 

An alternative formulation of matrix K/j defined in eq. fl66|) can then be written as 



K, 



de 



'A 



Sa 



R. 



(76) 
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